#include <joyos.h>

#include "define.h"
#include "skunk.h"

void calibrateSkunkServo(){
	printf_P (PSTR("\nSkunk to Open Position!"));
	go_click();
	servo_set_pos(SERVO_SKUNK, 511);
	printf_P (PSTR("\nPut it BACK NOW!"));
	go_click();
}

void openSkunk(){
	servo_set_pos(SERVO_SKUNK, 511);
	pause(500);
}

void closeSkunk(){
	servo_set_pos(SERVO_SKUNK, 120);
	pause(500);
}
